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ABSTRACT 


In  this  paper  we  discuss  dynamic  control  of  a  free-flying  space  robot  system 
where  the  bcise  attitude  is  not  controlled  by  thrust  jets.  Without  external  forces 
and  moments,  the  system  is  governed  by  linear  and  angular  momentum  conser¬ 
vation  laws.  We  first  derive  the  system  dynamic  formulations  in  joint  space  and 
in  inertia  space,  bcised  on  Lagrangian  dynamics.  Then  we  discuss  the  fact  that 
dynamics  of  a  space  robot  system  can  not  be  linearly  parameterized,  as  opposed 
to  the  case  of  a  fixed-based  robot.  Revealing  this  property  is  significant  since  the 
linearity  of  parameterization  has  been  used  as  a  prerequisite  for  various  adaptive 
and  nonlinear  control  schemes  currently  used  in  the  robot  control.  Based  on  the 
dynamic  model  of  the  space  robot  system,  a  simple  linear  control  scheme  is  pre¬ 
sented  for  the  normal  regulation  problem  for  tasks  in  space,  such  as  holding  lights 
for  illuminating  objects  or  handing  an  astronaut  tools  in  extra-vehicular  activity. 
A  globally  stable  dynamic  control  scheme  is  proposed  for  trajectory  tracking  ap¬ 
plications,  such  as  catching  moving  objects  or  structure  inspection  for  the  space 
station.  The  dynamic  control  algorithm  exhibits  a  fast  and  accurate  motion  re¬ 
sponse  even  when  the  mass/inertia  ratio  of  the  base  with  respect  to  the  robot  is 
low.  The  effectiveness  of  the  proposed  algorithms  are  demonstrated  by  simulation 
studies. 


in 


1  Introduction 


Robotic  technology  offers  two  potential  benefits  for  future  space  exploration.  One  benefit  is  min¬ 
imizing  the  risk  that  astroni.  s  face,  since  the  environment  for  humans  in  space  is  inhospitable, 
such  as  high  vacuum,  extreme  glare  and  temperature,  possibly  high  level  of  radiation.  The  other 
benefit  is  increasing  the  productivity  of  the  mission,  because  the  extra-vehicular  activity  (EV.A) 
consumes  considerable  time  and  can  require  the  degree  of  dexterity  exceeding  human  capability. 
The  use  of  robots,  however,  is  a  challenge  problem  for  control  of  both  robot  and  space  vehicle  that 
the  robot  is  attached  to  as  a  base.  Considerable  research  efforts  have  been  directed  to  man-machine 
interfacing  of  telerobotics  [3,  21],  control  of  light-weight  flexible  space  robots  [.5],  and  development 
of  space  robot  concept  [15,  4,  21]. 

Only  recently  the  research  on  dynamics  and  control  of  a  space  robot  system  by  considering  the 
interaction  between  the  space  robot  and  the  base  (spacecraft,  space  station,  or  satellite)  has  begun. 
Due  to  the  dynamic  interaction,  the  motion  of  space  robots  can  alter  the  base  trajectory.  On  the 
other  hand,  the  robot  end-effector  may  miss  the  desired  target  due  to  the  motion  of  the  base.  This 
mutual  dependence  severely  affects  the  performance  of  both  robot  and  base,  especially  when  the 
mass  and  the  moment  of  inertia  of  the  robot  and  payload  are  not  negligible  in  comparison  to  the 
base.  .Any  inefficiency  in  the  planning  and  control  can  considerably  risk  the  success  of  the  space 
mission. 

Lindberg,  Longman,  and  Zedd  [10]  addressed  several  issues  related  to  dynamics  and  kinematics 
of  a  space  robot  system  when  the  base  is  controlled  in  orientation  but  free  in  translation,  and 
when  the  base  is  free  in  both  orientation  and  translation.  In  the  paper  [9],  Longman  discussed  the 
kinematic  relationship  in  joint  space  and  inertia  space,  called  forward  and  inverse  kinetics  problems, 
and  the  workspace  of  a  space  robot.  Vafa  and  Dubowsky  [19,  20],  and  Papadopoulos  and  Dubowsky 
[13]  introduced  the  concept  of  Virtual  Manipulator  to  represent  the  dynamics  of  a  space  robot 
system.  The  virtual  manipulator  concept  makes  it  possible  to  reproduce  the  kinematic  behavior  of 
a  space  robot  by  the  kinematics  of  a  modified  fixed-base  robot.  They  applied  this  concept  to  plan 
robot  motions  that  minimize  disturbances  to  the  spacecraft,  and  recently  to  study  the  singularity 
problem  of  space  robots.  Due  to  the  conservation  of  angular  momentum,  non-integrable  velocity 
constraints  result  in  the  nonholonomic  nature  of  a  space  robot,  and  were  discussed  by  Nakamura 
and  Mukherjee  [12].  Umetani  and  Yoshida  [18]  proposed  a  resolved  rate  and  acceleration  control 
based  on  the  Generalized  Jacobian  Matrix  of  a  space  robot.  Masutani,  Miyazaki,  and  .-'irimoto 
[1 1]  addressed  feedback  control  problems  of  a  space  robot  system.  .•Mexander  and  Cannon  [2],  and 
Ullman  and  Cannon  [16]  provided  an  experimental  study  in  autonomous  navigation  and  control  of 
a  free- flying  space  robot. 

In  this  paper,  we  address  the  problem  of  controlling  a  space  robot  when  the  base  is  not  controlled 
by  thrust  jets.  The  base  attitude  can  be  normally  controlled  by  reaction  wheels  or  thrust  jets. 
Reaction  wheels  can  be  installed  in  three  perpendicular  directions  and  their  speeds  can  be  .altered 
to  control  the  orientation  of  the  body.  In  this  case,  the  linear  and  angular  momenta  are  conserved 
because  no  external  force  is  applied.  When  thrust  jets  are  used  to  control  the  attitude  of  the  base, 
however,  linear  and/or  angular  momenta  are  not  conserved,  due  to  external  thrust  forces.  We 
consider  the  case  when  the  robot  works  on  a  base  with  no  thrust  jets  in  this  paper.  Therefore, 
the  robot  is  completely  free-flying  in  zero-gravity  environment.  This  unique  feature  results  in  two 
properties  of  the  space  robot  with  respect  to  the  fi.xed-base  robot.  First,  the  kinematic  mapping 
from  joint  space  to  Cartesian  (inertial)  space,  or  vice  versa,  is  no  longer  unique  and  is  in  relation 
to  not  noly  the  current  positions,  but  also  to  the  past  path  that  the  robot  follows.  Second,  the 
kinematic  relationship  is  dependent  on  dynamic  parameters,  such  as  the  mass  and  the  moment  of 
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inertia. 

In  this  paper,  first  we  systematically  formulate  kinematics  and  dynamics  equations  of  a  free- 
flying  space  robot  system,  based  on  linear  and  angular  momentum  conservation  law  and  Lagrangian 
dynamics.  Then  the  dynamic  properties  of  the  system  are  studied.  It  is  found  that  the  free-flying 
space  robot  dynamics  cannot  be  linearly  expressed  in  terms  of  dynamic  parameters,  such  as  the  mass 
and  inertia  of  the  robot.  In  other  words,  it  is  impossible  to  properly  choose  a  set  of  combinations  of 
dynamic  parameters,  such  that  the  dynamics  can  be  represented  by  product  of  two  functions,  one 
with  dynamic  parameters,  and  the  other  with  no  dynamic  parameters.  This  results  in  infeasibility 
of  many  control  schemes,  such  as  most  existing  adaptive  control  schemes,  which  use  this  properly 
as  a  prerequisite. 

Based  on  the  derived  dynamic  model  in  inertia  space,  two  control  schemes  are  proposed  for 
normal  regulation  and  trajectory  tracking  problems.  Applications  of  regulation  control  can  be 
found  in  various  tasks  in  space,  such  as  lights  holding  for  illuminating  objects,  or  handing  tools 
to  astronauts  in  e.xtra-vehicle  activity.  For  inspection  of  the  structure  or  surface  of  the  space 
station,  or  parts  transporting,  trajectory  tracking  is  essential.  The  PD-based  regulator  is  simple 
to  implement  and  works  well  for  the  large  mass/inertia  ratio  (bass/robot).  The  tracking  controller 
makes  full  use  of  dynamic  model,  therefore  allows  more  accurate  and  fast  motion  even  for  the  small 
mass/inertia  ratio  (bass/robot).  The  effectiveness  of  the  control  schemes  proposed  is  demonstrated 
by  simulation  results. 

2  Kinematics  of  the  Space  Robot  System 

In  this  section,  we  will  discuss  kinematics  of  the  free-flying  space  robot  system.  .A.s  pointed  out 
previously,  since  the  kinematics  in  this  case  is  actually  mass  and  inertia  related,  it  is  completely 
different  from  the  conventional  fixed-based  robots.  Our  discussion  in  this  section  is  focused  on  the 
motion  relationship  between  the  joint  space  and  inertia  space,  without  explicitly  involving  acceler¬ 
ation.  Some  papers,  such  as  [9,  17,  11],  have  derived  kinematics  equations,  but  for  the  purpose  of 
developing  dynamic  control  scheme  and  easy  understanding  the  discussion  in  the  following  sections, 
we  provide  a  uniform  formulation  for  kinematics  of  a  space  robot  system. 

.A.  space  robot  attached  to  spacecraft  on  the  orbit  is  considered  as  a  free-flying  system  in  the 
non-gravitational  environment.  The  system  is  modeled  cis  a  set  of  n  -|-  1  rigid  bodies  connected 
by  n  joints,  which  are  numbered  from  1  to  n.  A  joint  variable  vector  q  =  (71,  <72>  •  ■  ■ ,  <7n  is  used 
to  represent  those  joint  displacements.  Each  body  is  numbered  from  0  to  n,  and  the  base  can  be 
named  as  B  in  particular.  The  mass  and  inertia  of  ith  body  are  denoted  by  rrii  and  T,  respectively. 

\V'’e  define  two  coordinate  frames,  the  inertia  coordinate  on  the  orbit,  and  the  base  coordinate 
attached  on  the  base  body  with  its  origin  at  the  centroid  of  the  base.  As  shown  in  Figure  1. 
let  R,  and  r;  be  the  position  vectors  pointing  the  centroid  of  ith  body  with  reference  to  Yli  ‘titd 
Xje  respectively,  then 


R.  =  r, -l-Rs  (1) 

where  Re  is  the  position  vector  pointing  the  centroid  of  the  base  with  reference  to 

In  general,  the  desired  motion  of  a  manipulator  is  specified  in  terms  of  hand  trajectory  in  inertia 
coordinate,  while  the  servo  control  system  requires  that  the  reference  inputs  be  specified  in  joint 
coordinate.  The  relationship  between  the  inertia  coordinates,  such  as  lift  sweep  py,  reach  p_-. 
yaw  a.  pitch  /3,  and  roll  7.  and  the  joint  angular  motion  in  fixed-base  case  is  inherently  nonlinear 
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Link  n 


Figure  1:  A  free-flying  space  robot  system  model, 
and  can  be  generally  expressed  by  a  nonlinear  vector  function 

X(0  =  /(q(0)  (2) 

where  /  is  a  vector  function,  and  X(t)  and  q(t)  are  vectors  representting  state  variables  in  the 
inertia  coordinates  X(t)  =  (pi,  Py,  pz,  a,  0,  7)^,  and  in  joint  coordinates  q{t)  =  (71, 92*  •  •  •  ^  7n)^- 

In  free-flying  case,  however,  it  must  be  noted  that  even  the  forward  kinematics  is  difficult  to 
solve.  The  position  and  orientation  of  the  hand  may  not  have  a  closed-form  solution  because  it 
depends  on  the  inertia  property  which  changes  with  configurations.  Thus  the  solution  is  function 
of  the  history  of  the  configurations  [9],  The  inverse  kinematics  problem  is  even  more  difficult  to 
tackle. 

One  possible  solution  to  this  dilemma  is  to  discuss  the  kinematics  problem  indirectly  by  motion 

rates  rather  than  by  displacements.  It  has  been  found  [17]  that  the  motion  rate  of  the  hand  and  that 

of  joint  variables  can  be  linearized  excluding  from  their  history.  If  the  trajectory  at  the  initial  state 
and  the  joint  motion  rate  at  each  step  are  determined,  the  trajectory  of  position  and  orientation 
of  the  hand  in  inertia  space  can  be  obtained  by  numerical  integration. 

Let  V,  and  fi,  be  linear  and  angular  velocities  of  ith  body  with  respect  to  v,  and  w',  with 
respect  to  Then  we  have 

V.  =  V,  -t-  Vg  -I-  Qg  X  Fi 

n,  =  u;,  Qg  ( 3 ) 

where  Vg  and  fig  are  linear  and  angular  velocities  of  the  centroid  of  the  ba.se  with  respect  to  Yli- 
and  operator  'x'  represents  outer  product  of  vector.  The  velocities  in  base  coordinates  v,  and 
can  be  represented  by 

=  J.(q)q  (1) 
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where  J{(q)  is  the  Jacobian  of  the  ith  body, 


J. 

Vi 


Wi 


JL.(q) 

J4.(q) 

JLi(q)q 

J>ii(q)q 


(5) 

(«) 

(7) 


In  what  follows,  we  derive  the  relationship  between  motion  rate  in  inertia  coordinates  and  that 
in  joint  coordinates.  The  linear  and  angular  momenta  P  and  L  are  defined  as 


P  =  X^miVi  (,S) 

1=0 
n 

L  =  ^iffii  +  m.R,  X  Vi  (9) 

i=0 

where  if  is  the  inertia  tensor  in  Sfl.  Now  we  define  the  following  for  the  centroid  of  whole  system. 


n 

TTic  =  ^  ~  tn.i 

i=0 
n 

=  ^miri/mc 
i=:l 
n 

Jc  =  X^miJti/mc 
i=l 

Substituting  Equations  (10,11,12)  to  (8,9)  yields 


p 

Hv^ 

_ 1 

'  Vs  ■ 

'  Hv,  ■ 

O3 

L 

Hn  J 

Slg 

+ 

Hq, 

q  + 

Rs  X  P 

Each  block  submatri.x  is  determined  by 


(10) 

(11) 


(Id) 


Hk  =  mcUs 

€ 

(M) 

Hvn  =  -m<,[rcX] 

(15) 

U  V  q  - 

(10) 

n 

X;[lf +  m,D(r.)]  +  Is 

t  =  l 

(IT) 

n 

^[If  J4.  +  m.[r.x]JL.]  € 

1=1 
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where  U3  is  a  3  X  3  unity  matrix,  O3  is  a  3  x  3  zero  matrix.  The  matrix  functions  [rx]  and  D(r) 
for  a  vector  r  =  [rx,ry,rj]^  are  defined  as 

0  -rj  Ty 

[rx]  =  r,  0  -T^ 

-Ty  Tj.  0 

{  rl  +  rl  -Tj,ry  -r^r, 

D(r)  =  [rx]^[rx]  =  rl  +  -r^r,  (20) 

-TtV:  -TyT^  tI-\-  rl  _ 

Because  in  free-flying  case  we  assume  that  there  are  no  gravitational  force  and  no  external  forces 
acting  on  the  system,  therefore,  the  linear  and  angular  momenta  of  the  system  are  conserved. 
Without  loss  of  generality  we  assume  that  the  system  is  stationary  in  the  initial  state.  This  implies 
that  total  linear  and  angular  momenta  are  zero.  Substituting  P  =  O3  and  L  =  O3  into  (13)  wo 
obtain 


where 


riieref'ore. 


where 


Vb  =  H£,(q)q  (21) 

=  H^(q)q  (22) 

Hl  _  _  Hv  Hv? 

_  H,4  J  ■  Hfi  [  Hn, 


(23) 


-Jc  -  [roXjHg'HM 

(21) 

Hs  = 

Hn  -  mcD(rc) 

(25) 

Ha;  = 

Hn<?  -  mc[rcX]Jc 

(20) 

Vb 

=  Vb  -1-  Vb  +  Hb  X  tb 
=  NBq 

(27) 

Hb 

=  +  Hb 

=  N.4q 

(2S) 

'  Vb  ■ 
0  c 

=  N(q)q 

(29) 

(30) 

Nb  =  JB  +  HB-[rEX]H4 

=  Jb  -  Jc  -  [(re  -  rc)x|Hg'H,\; 

(31) 

N.,  =  J4+H,4 
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(32) 


j(a]  - 

-  [j^(q)J 

and  rs  is  the  hand  position  with  respect  to  the  base,  J  is  the  conventional  fixed-based  Jacobian  of 
the  robot  with  respect  to  the  base,  N  is  so-called  the  generalized  Jacobian  [17]  which  is  not  only 
a  function  of  robot  motion  but  also  function  of  the  base  motion. 

Let  r  =  [ti,  •  •  • ,  r„]^  be  a  vector  of  joint  torques  corresponding  to  the  joint  coordinates  q,  and 
F  =  [Fj;,  Fy,  F2,Ti,Ty,T;]^  be  a  vector  of  the  generalized  force  in  the  inertia  coordinates.  Assume 
that  there  exist  virtual  displacements  (5x  and  ^q  in  inertia  space  and  in  joint  space,  respectively. 
The  relationship  between  6x  and  ^q  is 

=  Wq  (33) 

where  N  is  the  generalized  Jacobian.  By  the  virtual  work  principle, 


Su^ork  =  r'^Sq  -  F'^Sx  =  (r  -  N^F)^<5q  =  0 


for  all  (5q,  therefore, 


r  =  N^F 


This  relationship  will  be  used  in  dynamic  control  in  the  following  sections. 


3  Dynamics  of  the  Space  Robot  System 

Based  on  Lagrangian  dynamics,  we  formulate  the  dynamics  equation  in  joint  space  as  follows.  It 
is  known  that  the  total  kinetic  energy  of  the  space  robot  system  is  given  in  terms  of  variables  in 
joint  space  by 

K=iq^M(q)q  (35) 

whore  M(q)  is  a  6  x  6  symmetric  kinetic  energy  matrix. 

Since  the  space  robot  works  in  non-gravitational  environment  and  we  assume  that  no  elastic 
body  is  involved,  the  potential  energy  can  be  regarded  as  zero.  Thus,  the  Lagrangian  formulation. 


yields  the  motion  equation 

d  c>K 

dt  dq  dq 

(3(i) 

Mq  -1-  B(q,q)q  =  r 

(37) 

where 

B(q.q)q  =  Mq  -  ^(^q^Mq) 

(3S) 

and 

M  =  H,  - 

(39) 

is  symmetric  and  positive  definite,  and 
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(-10) 


i=l 

is  the  inertia  matrix  of  the  robot  when  the  base  is  fixed. 

From  (37)  to  (40)  we  can  observe  the  following  properties  of  the  dynamics  model  for  a  free- flying 
space  robot. 

•  .As  in  the  fi.xed-based  robot  system,  M  and  B  ere  not  independent,  and  M  —  2B  aie  skew- 
symmetry.  This  can  be  easily  seen  by  energy  conservation  principle,  i.e., 

which  implies 

q^(M  -  2B)q  =  0 


•  The  inertia  matri.x  M  is  composed  of  two  parts,  manipulator  inertia  matri.x  Mj  which  is 
completely  independent  of  the  base  dynamics  and  only  a  function  of  the  robot  motion  with 
respect  to  the  base  coordinates,  and  coupled  inertia  matrix  M2  which  lakes  the  dynamic 
interaction  into  consideration.  That  is. 


M  =  Ml  +  M2  (11) 

M,  =H,  (42) 

M2  =  -mcJjJc  -  (13) 

Since 

B(q,q)q  =  Mq  -  ^(^q^Mq)  (14) 

if  M  can  be  decomposed  into  two  parts.  Mi  and  M2,  then  B  can  ahvays  be  decomposed 
into  two  parts  Bi  and  82-  In  this  way,  dynamics  of  the  system  can  also  be  viewed  as  a 
combination  of  two  subsystems  corresponding  to  the  manipulator  part  and  interaction  part. 

T-  =  Ti  +T2 
Ti  =  Miq -1- Bi(q,q)q 
r2  =  M2q+B2(q,q)q 

The  first  part  ri  is  linear  in  terms  of  robot  dynamic  parameters  such  as  mass  and  inertia 
tensor,  and  nonlinear  in  terms  of  kinematic  parameters.  The  second  part  T2  is  completely 
nonlinear  in  terms  of  both  kinematic  and  dynamic  parameters,  as  we  will  discuss  later  in 
detail.  By  kinematic  parameters  w'e  mean  joint  variables  and  geometrical  parameters  of 
links. 

•  When  the  base  mass/inertia  is  sufficiently  large  compared  to  that  of  the  robot  and  the  load 
being  manipulated,  the  effect  of  the  dynamics  of  the  second  part  is  reduced,  as  M2  is  in¬ 
versely  proportional  to  and  4  which  are  total  mass  and  moment  of  inertia  of  the  system 
respectively.  The  first  part  dynamics  T]  does  not  change  since  it  is  independent  of  the  base 
parameters.  The  first  part  dynamics  ri  therefore  dominates  the  whole  system. 


•  The  most  important  property  of  the  free-flying  space  robot  system  that  will  be  addressed 
in  detail  is  nonlinearity  of  parameterization  with  respect  to  the  dynamic  parameters  wliich 
makes  the  control  of  the  space  robot  system  much  different  from  that  of  the  fixed  based  robot 
system.  We  will  discuss  this  issue  in  the  following  section,  nonlinearity  of  parameterization. 

In  the  similar  way,  we  can  obtain  the  dynamic  equation  of  a  space  robot  system  in  inertia  space. 

The  detail  derivation  can  be  found  in  Appendix  1. 


Hx+  C(x,x)x  =  F 


(-15) 


where 


C(x,x)x  =  Hx  -  ^(^x^Hx) 


(16) 


and  H  is  symmetric  and  positive  definite,  H  —  2C  is  skew-symmetry.  For  simplicity,  we  include 
all  derivation  process  in  .4ppendix  1.  The  relationship  between  joint  space  dynamics  and  inertia 
space  dynamics  can  be  summarized  as  follows. 


X  =  N(q)q 


X  =  N(q)q-1-N(q,q)q 


(-18) 


F  =  N-^(q)r 


(.19) 


H(x)  =  N--^(q)M(q)N-Hq)  (.50) 

C(x,x)x  =  N"^(q)B(q,q)q  -  H(x)N(q,q)q  (51 ) 

Obviously,  the  inertia  matrix  H  is  even  more  complicated  than  its  counterpart  in  joint  space  M 
because  it  involves  inversion  of  the  generalized  Jacobian  matrix. 


4  Nonlinearity  of  Parameterization 

In  this  section  we  discuss  one  of  fundamental  differences  in  dynamics  between  the  fi.xed-based  robot 
.uid  the  free-flying  space  robot,  nonlinearity  of  parameterization.  We  first  discuss  the  linearity  of 
l)arameterization  in  dynamics  of  the  fixed-base  robot  and  its  importance  in  control.  Then  we 
demonstrate  the  nonlinearity  of  parameterization  in  dynamics  of  the  free-flying  space  robot. 

The  property  of  linear  parameterization  of  the  fi.xed-based  manipulator  dynamics  is  important 
for  both  controller  design  and  dynamics  analysis  [8].  It  has  been  used  as  one  of  prerequisite 
conditions  in  design  of  most  of  nonlinear  dynamic  control  and  adaptive  control  for  conventional 
robot  manipulators  [7,  14].  Let’s  take  adaptive  control  as  an  e.xample  to  illustrate  the  importance 
of  linear  parameterization  of  manipulator  dynamics. 

Present  robot  adaptive  control  schemes  can  be  generally  classified  into  three  categories,  direct, 
indirect,  and  composite  adaptive  control.  Nearly  all  of  these  algorithms  are  based  on  the  property  of 
linear  parameterization  in  the  robot  dynamics,  i.e.,  possibility  of  selecting  a  proper  set  of  equivahuit 
parameters  such  that  the  robot  dynamics  depends  linearly  on  these  parameters.  These  controllers 
can  take  full  consideration  of  the  nonlinear  time- varying  and  coupled  dynamics,  without  unrealistic 
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assumptions  on  linearization  of  robot  dynamics,  or  on  decoupled  joint  motions,  or  on  slow  variation 
of  the  inertia  matrix  used  by  early-day  robot  adaptive  controllers. 

According  to  Equation  (35),  the  system  dynamics  can  be  linearly  parameterized  if  both  M  and 
B  can  be  linearly  parameterized.  From  Equation  (36),  linear  parameterization  of  B  depends  on 
that  of  M.  Therefore,  the  problem  of  linear  parameterization  of  space  robot  dynamics,  can  be 
reduced  to  the  problem  of  linear  parameterization  of  inertia  matrix  of  the  free-flying  robot  system 
since  the  space  robot  works  in  zero-gravity  environment  and  no  gravity  force  is  involved  in  dynamics 
equation.  If  the  property  of  linear  parameterization  were  stiU  vabd,  most  of  existing  algorithms 
for  controlling  the  fi.xed-based  robot  would  be  applicable  to  the  free-flying  space  robot  systems. 
Unfortunately,  this  property  is  no  longer  valid  here.  We  will  demonstrate  that  it  is  impossible  to 
linearly  parameterize  dynamics  of  the  free-flying  space  robot  system,  in  theory  and  by  case  study. 

As  we  have  derived,  the  inertia  matrix  M  can  be  represented  by 


M  =  Ml  -f  M2 

(52) 

Ml  =H, 

(53) 

M2  =  -moJ^Jc-Hii^Hg'HM 

(5-1) 

Therefore,  the  problem  of  linear  parameterization  of  inertia  matrix  becomes  the  possibility  of 
linear  parameterization  of  M2,  since  Mi  is  the  inertia  matrix  of  the  fixed-base  robot  which  can  be 
linearly  parameterized  [8].  Now  we  examine  whether  M2  can  be  linearly  parameterized  in  terms 
of  dynamic  parameters. 


Refer  to  Equation  (12), 


n 

Jc  “  ^  ^  Lil 

i=l 

(55) 

thus. 

liLf'  •  4  «  flllf' 

1  =  1  jz=l  1  =  1  2  =  1 

(56) 

where  R^j  is  a  function  of  geometric  parameters  and  joint  variables,  and  independent  of  dynamic 
parameters.  Therefore,  the  first  term  in  M2  can  be  linearly  determined  by  choosing  a  set  of 
parameters  m,mj/mc  {i,j  =  l,...,7i). 

Then  we  examine  the  second  term,  which  is  much  more  complicated.  From 

previous  derivation,  we  have 


n 

Hfi  =  ^(I,  -p  m,D(r.))  +  Is  -  7ncD(rJ 
1=1 


Hs‘ 


Hs 

det(HB) 


(58) 


where  Hg  is  the  adjoint  of  the  matri.x  He- 

It  can  be  observed  that  the  linear  parameterization  of  the  second  term  is  possible  only  if  ilot(  Hs ) 
can  be  reduced  from  all  elements  of  Hs  H,\/,  or  if  it  can  be  expressed  as  a  product  of  two  scalar 
functions  with  only  one  containing  dynamic  parameters.  Because  Hs  is  time  varying  and  couph'd, 
(let(Hs)  can  not  be  eliminated  from  H^HgHAf.  Furthermore,  det(Hs)  can  not  be  expressed  as 
a  linear  scalar  function  with  respect  to  any  set  of  combinations  of  dynamic  parameters.  Therefore, 
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the  second  term  of  the  inertia  matrix,  can  not  be  linearly  parameterized  in  terms  of 

dynamic  parameters. 

From  the  2-D  example  given  in  the  case  study  section,  we  can  take  a  closer  look  at  property  of 
the  term  where  Hg  is  reduced  to  a  scaler, 

Hb  =  h  +  h  +  +  y\)  +  m^ixl  +  yl)  +  +  r^y)  (59) 

H.m  =  [/;  +  I2J2]  +  Tni[-ricy,ri<^]Ji  +  Tn2[-r2cy,  r2cr]J2  (90) 

It  can  be  easily  seen  that  cannot  be  reduced  by  Hb-  On  the  other  hand,  Hb  can  not 

be  expressed  as  a  product  of  two  scalar  functions  with  one  including  combinations  of  dynamic 
parameters  (/q,  h,  I2,  mi,  m2),  and  the  other  excluding  these  parameters.  Thus,  it  is  impossible 
to  linearly  parameterize  space  robot  dynamics  even  for  the  simple  2-D  case. 

It  is  noted  that  the  previous  analysis  is  for  the  inertia  matrix  in  joint  space.  In  inertia  space, 
the  inertia  matrix  H  =  is  even  more  complicated,  due  to  inversion  of  the  generalized 

Jacobian  matrix  N.  In  the  same  manner,  it  can  be  shown  that  the  dynamics  equation  in  inertia 
space  can  also  not  be  hnearly  parameterized  for  the  space  robot  system. 

5  Dynamic  Control  Algorithms 

Based  on  previous  dynamic  formulations,  in  this  section  we  derive  control  schemes  for  the  free-flying 
space  robot  system. 

It  must  be  noted  that  the  desired  position  or  trajectory  of  the  space  robot  system  usually  is 
specified  in  inertia  space,  while  it  can  not  be  uniquely  mapped  into  the  joint  space  where  control 
is  executed.  Using  the  pseudo-inverse  method,  we  can  find  at  least  one  solution  of  the  joint  angles 
based  on  the  given  position  in  inertia  space  [1].  This,  however,  requires  frequent  calibration  and 
computational  comple.xity.  Therefore,  we  propose  our  control  schemes  in  inertia  space,  other  than 
in  joint  space. 

We  consider  two  basic  cases  in  controlling  the  space  robot  system,  regulation  and  tracking.  In 
regulation,  we  position  the  robot  hand  to  the  desired  location,  or  target  location,  in  inertia  space. 
This  type  of  tasks  can  be  useful  for  holding  lights  illuminating  the  objects  or  handing  an  astronaut 
some  tools  in  extra-vehicular  activity.  In  tracking,  we  control  the  robot  hand  motion  to  follow  the 
given  trajectory.  This  type  of  task  is  essential  in  inspection  of  space  station  structure  and  surface, 
part  transport,  or  light  assembly.  In  what  follows,  we  first  develop  a  simple  PD  control  scheme 
for  regulation  control,  and  then  propose  a  globally  stable  dynamic  control  scheme  for  tracking 
applications. 

5.1  Regulation 

Let  X(  and  x  be  the  generalized  displacement  vectors  of  the  target  which  the  robot  is  to  reach,  and 
of  the  robot  hand  in  inertia  space,  respectively.  The  difference  between  them  is  denoted  by 

Cp  =  X  -  Xt  (Gl) 

The  objective  of  regulation  is  to  control  robot  such  that  x  converges  to  the  given  X(,  assuming 
X(  is  within  the  nonsingular  workspace  of  the  robot. 

Theorem  1  If  the  following  regulator  in  inertia  space  is  applied  to  the  dynamic  system  (j5)  in 
inertia  space, 

F  =  -(Kpep -I- K,iep)  (G2) 
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where  Kp  and  K,i  are  constant,  diagonal  gain  matrices  with  positive  kpj  and  k^j  on  the  diagonals, 
or  a  corresponding  regulator  in  joint  space  is  given  by 

T  =  N^F  =  -N^(Kpep  +  K^ep)  (G3) 

then  the  equilibrium  state  Xj  =  x  is  asymptotically  stable,  if  N  is  of  full  rank. 

Proof 

A  Lyapunov  candidate  is  taken  as 

=  ^(x^Hx  + ejKpCp)  (G4) 

L'sing  the  skew  symmetry  of  the  matrix  (H  -  20),  the  time  derivative  of  Vi{t)  becomes 

1/1(0  =  +  KpCp)  (Go) 

Substituting  (62)  into  (65)  yields 

l/i(0  = -x^Kjx  <  0  (GG) 

Thus,  Fi  =  0  iff  X  =  0.  This  implies  that  x  =  -H'^KpCp.  Therefore,  one  has  Fi  =  0  only  if 

Gp  =  0. 

□ 

Note  that  the  position  convergence  of  the  simple  PD  controller  (62)  does  not  require  a  priori 
knowledge  of  system  dynamic  parameters.  However,  the  controller  (63)  in  joint  space  does  require 
a  priori  knowledge  of  dynamic  parameters,  because  the  generalized  Jacobian  N  is  invloved.  For  a 
given  set  of  control  gains,  its  transient  response  also  depends  on  system  dynamic  parameters,  as 
well  as  the  modeling  error. 

5.2  Tracking 

The  objective  of  tracking  is  to  constrain  the  robot  hand  motion  to  follow  the  given  trajectory 
in  inertia  space  which  is  determined  by  task  specifications.  For  example,  in  the  task  of  catching 
a  moving  object  in  space,  the  trajectory  and  velocity  of  the  robot  before  and  after  catching  arc 
determined  by  motion  requirement  of  catching  and  trajectory  of  the  object.  Measurement  for  the 
robot  hand  position  in  inertia  space  may  not  be  an  easy  problem,  since  a  wide  range  sensor  may 
not  be  found  in  space  applications.  Laser  range  finder  may  be  a  good  candidate  as  proposed  in  [G]. 
In  the  case  that  the  hand  position  can  not  be  directly  measured,  it  still  can  be  determined  by  using 
joint  measurements,  base  location,  and  the  generalized  Jacobian  matrix.  This  requires,  however, 
that  the  base  location  in  inertia  space  is  measurable,  and  at  the  same  time  introduces  observing 
errors.  From  now  on  we  assume  the  measurement  of  the  robot  hand  in  inertia  space  is  available. 
Moreover,  we  assume  that  the  desired  Xd,  Xd  and  Xd  are  bounded. 

Theorem  2  For  the  dynamic  system  (45),  if  we  apply  a  dynamic  control  law  in  inertia  space 

F  =  H(x,i  +  +  KpCp) -b  C(x,x)x  (67) 

and  the  corresponding  control  torques  in  joint  space  is  given  by 

T  =  N^F  =  N^[H(x,i  +  KdBp  +  KpGp)  +  C(x,x)x]  (G.S) 

then  the  equilibrium  state  is  asymptotically  stable,  if  N  is  of  full  rank. 
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Proof 

If  we  substitute  (67)  into  (45),  then  we  get 


Cp  -f  K^iCp  -h  KpCp  —  0 

(69) 

where  Kp  and  Yid  can  be  so  chosen  that  the  system  has  the  desired  performance  by  pole  assignment. 
We  select  a  Lyapunov  candidate  as 

K2(0  =  5(eJep-hejKpep) 

(70) 

Differentiating  it  with  respect  to  time. 

^2(0  =  e^(ep  +  KpCp) 

(71) 

i.e. 

^2(0  =  -x^K<fX  <  0 

(72) 

I')  =  0  implies  that  x  =  x  and  x  =  X(.  This  proves  that  the  equilibrium  state  is  asymptotically 
stable. 

□ 

In  the  above  control  scheme,  we  have  incorporated  complete  dynamics  of  the  system.  With  the 
knowledge  of  complete  system  dynamics,  the  robot  can  follow  a  given  trajectory  and  enhance  the 
desired  motion  performance.  Most  of  existing  approaches  for  the  free-flying  space  robot  system 
are  kinematics-based  control  scheme,  though  they  may  involve  the  generalized  Jacobian  matrix 
which  is  dynamics  dependent  [11,  18].  The  effectiveness  of  dynamic  control  can  be  demonstrated 
in  simulation  study  of  the  following  section. 


6  Simulation  Study 


To  better  understand  the  space  robot  dynamics  and  demonstrate  the  validity  of  the  proposed 
control  laws,  we  discuss  a  case  study  in  this  section.  The  model  of  a  two-dimensional  free-flying 
space  robot  system  model  is  shown  in  Figure  2.  For  simplicity,  we  locate  the  robot  base  at  the 
centroid  of  the  base,  and  links  of  the  robot  are  represented  by  lumped  mass. 

The  position  vectors  of  the  base,  link  1  and  link  2  in  inertia  space  are  denoted  by  Rq,  Ri  and 
R.),  respectively.  The  position  vectors  of  link  1  and  link  2  in  the  base  frame  are  ri  and  ro. 


Ro  = 


•Vo 

Ko 


R.  = 


-V, 

n 


R,  = 


ri  = 


r  -f-  lici 

yi 

llSi 

X2 

f  +  h<^\  +  ^2Cl2 

.  . 

l\Si  -h  l2Sl2 

^2 


r2  = 


where  Ci  =  cos{qi),  Sij  =  sin{q\  -t-  r/j),  etc. 

We  further  simplify  the  model  by  assuming  fj  =  =  1  and  mi  =  m2  =  m  thereafter. 


(73) 

(74) 

(75) 


vi  =  fi  =  Jiq 


(76) 
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Base 


Figure  2:  A  free- flying  planar  space  robot  system. 


V2  =  f2  =  J2q 

(77) 

W’l  =  J.4iq 

(78) 

^2  =  ^^12^ 

(79) 

q  = 

(•'^0) 

-Isx  0  ' 
lc\  0 

J2  = 

-lS\  —  lsi2  —lSi2 
lc\  +  lC\2  fci2 

(SI) 

J.-ti  = 

=  (l,0]  J.42  =  [l,l] 

(■^2) 

The  centroid  of  the  whole  system  can  be  determined  as  foOows 

rric 

Tc 

Jc 

The  velocities  of  two  links  are 

Vi  ^ 

V2  = 


=  mo  +  m  -h  m 
m  m 

=  — r,  +  — r2 

me  me 

m  T  m  _ 
-Ji  d - J2 

»c  Trie 


TTXf 


Vi  +  Vq  +  fJo  X  Tj 
Vo  +  Jiq  -  r,  X  fio 
Vo  +  J2q  -  r2  X  fio 
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Ho  + 

fio  +  J/124 


Qi  = 

= 


where  Qq  =  Qo- 

Following  derivations  in  Section  3  we  have 
mcC/2 

-miji  -  mj/2 
mil  -  mi2 

Fq  +  A  +  ^2  +  Tn(xi  +  J/i)  +  rn(x2  "h 

/7lJ|  -j-  n2J2 

(/i  +  /2,/2)  +  rn(-i/i,ii)Ji  +  m(-y2,ar2)J2 
//f2  -  m^D{r^) 
r-  +r^ 

[A  +  A,  A]  +  m[-(ri  -  rc)y,iri  -  rc)i]Ji  +  m[-(r2  -  rjy,(r2  - 

The  generalized  Jacobian  can  then  be  determined  by 

N  = 

Nl  =  J- Jo-[(r2-rc)5„-(r2-r,A]^//g>H,vr 

The  joint  space  system  dynamics  can  then  be  computed  by  using  Equations  (35)  to  (38)  and 
the  above  equations,  and  the  corresponding  dynamics  equation  in  inertia  space  can  be  obtained  by 
(-I0)  to  (51). 

Based  on  the  above  planar  model,  we  conduct  a  set  of  simulation  studies  to  verify  our  control 
algorithms.  In  the  simulation  we  assume  that  m  =  50(^5),  /  =  2.5(m),  oi  =  02  =  1.25(ni), 
/i  =  I2  =  26{kgTn^)  for  robot  parameters.  Initially  the  coordinate  Yli  coincides  with  J2b 
the  robot  hand  is  at  (2.5,0)  in  inertia  space.  In  the  following  discussion  the  mass/inertia  ratio  is 
referred  to  as  the  mass/inertia  ratio  of  the  base  with  respect  to  the  robot. 

The  base  is  completely  free-flying,  therefore  it  moves  and  rotates  in  response  of  the  robot 
motion.  Figure  3  depicts  the  space  robot  system  motion  trajectory  in  60  seconds  when  the  dynamic 
control  algorithm  is  applied  to  the  system,  with  the  mass/inertia  ratio  mo/m  =  Iq/I  =  2.  The 
base  e.xhibits  not  only  translation  but  also  rotation  when  the  robot  hand  tracks  along  a  specified 
horizontal  straight-line  trajectory. 

Figure  4  shows  position  errors  of  the  robot  hand  when  the  PD  control  with  gains  Kp  = 
diai/[400,400]  and  Kj  =  (iia(7[40,40]  is  selected.  The  target  trajectory  for  robot  hand  in  iner¬ 
tia  space  is  Xt  =  2.54-0.021,  Yt  =  0.  The  mass/inertia  ratio  of  the  base  with  respect  to  the  robot  is 
10  in  this  case.  It  is  found  that  the  simple  PD  control  algorithm  works  well  and  the  position  error 
converges  to  zero.  When  the  mass/inertia  ratio  is  decreased,  however,  e.g.,  mo/m  =  Iq/I  =  2, 
the  simple  PD  algorithm  may  cause  system  instability,  which  can  be  confirmed  by  Figure  5  whore 
e.xcessive  torques  is  needed  to  correct  divergent  joint  error  due  to  instability.  Under  the  e.xactly 
same  condition.  Figure  6  shows  the  required  joint  torques  using  the  dynamic  control  algorithm, 
and  It  can  be  found  that  the  torques  converges  as  the  error  converges  to  zero.  Various  simulations 
have  shown  that  the  PD  control  works  well  when  the  mass/inertia  ratio  is  not  too  small,  and  the 
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Figure  3:  Motion  trajectory  of  a  planar  free-flying  robot  system. 


dynamic  control  algorithm  present  an  e.xcellent  tracking  performance  even  when  the  mass/inertia 
ratio  is  small. 

For  the  case  that  mass/inertia  ratio  is  large,  e.g.,  mo/m  =  IqJ I  =  100,  the  required  input 
torques  are  plotted  in  Figures  7,  and  8.  VVe  observe  that,  though  the  PD  algorithm  works  well,  it 
reijuires  larger  Joint  torques  and  longer  transient  response  time  than  dynamic  control  scheme. 

Step  input  system  responses  are  also  studied.  Figure  9  shows  that  the  motion  trajectories  in  .V 
direction  under  different  control  algorithms.  The  commanded  step  input  is  from  ■2.5(m)  to  3(m).  It 
is  found  that  system  response  (dotted  line)  is  unstable  using  the  PD  algorithm.  However,  desired 
critical  damping  transient  response  performance  can  be  achieved  by  using  the  dynamic  control 
algorithm. 

Pliysically  how  much  mass/inertia  ratio  of  the  base  to  the  robot  is  desirable  and  feasible,  is  still 
to  be  determined.  When  the  base  is  a  space  station,  the  ratio  has  been  suggested  to  be  as  low  as 
3.  Intuitively,  the  lower  ratio  causes  more  significant  effect  of  dynamic  interaction  on  the  system 
performance.  Figure  10  shows  the  base  rotation  angles  when  the  mass/inertia  ratio  is  2.  10,  and 
100,  respectively.  It  is  found,  no  surprisingly,  that  the  less  the  ratio,  the  larger  the  base  rotation 
angle  as  a  response  of  the  robot  motion. 


7  Conclusions  and  Future  Work 

The  dynamic  control  of  a  space  robot  system  with  on  thrust  jets  controlled  base  has  been  studied 
in  this  paper.  We  presented  systematic  derivations  of  kinematics  and  dynamics  of  the  system. 
W'e  found  that  the  system  dynamics  can  not  be  linearly  parameterized,  which  makes  fundamental 
differences  on  the  control  of  a  fi.xed-base  robot  and  a  free-flying  space  robot.  Based  on  the  dynamic 
model  derived  in  inertia  space,  we  proposed  a  PD-based  control  algorithm  for  regulation  and  a 
dynamic  control  algorithm  for  trajectory  tracking  applications  in  space.  The  regulation  controller 
is  simple  and  easy  to  implement.  The  dynamic  controller  provides  a  stable  and  fast  system  response 
even  when  the  mass/inertia  ratio  of  the  base  with  respect  to  the  robot  is  small.  The  property  of 
nonlinear  parameterization  has  been  demonstrated  in  theory  and  by  a  case  study.  The  validity  of 
the  proposed  control  algorithms  are  verified  by  simulations  using  a  planar  space  robot  system. 

Some  future  research  issues  can  be  addressed  as  follows.  First,  in  space  applications,  velocity 


15 


measurements  may  not  be  available  or  inevitably  contaminated  by  noise.  It  is  therefore  worthwhile 
to  accurately  estimate  the  velocity  from  direct  available  measurements  such  a.s  position  in  inertia 
space.  Some  nonlinear  observers,  such  as  pseudo-linearization  technique,  sliding  observers,  and 
smooth  nonlinear  observers  can  be  adopted  to  this  purpose.  Second,  the  dynamic  control  algorithm 
is  computationally  expensive.  On-line  computation  of  inertia  matrix  and  inversion  of  generalized 
Jacobian  is  required.  It  can  be  improved  by  developing  efficient  algorithms  similar  to  recursive 
.\-E  formulation  in  fi.xed-base.  Third,  it  may  be  impossible  to  cancel  nonlinear  and  time- varying 
effect  by  using  the  proposed  control  law,  because  an  accurate  estimation  of  H  and  C  may  not 
be  available.  In  this  case,  adaptive  control  is  desirable.  Adaptive  control  algorithms  have  boon 
proposed  for  space  robot  system  with  an  attitude  controlled  base  in  [22].  For  completely  free-flying 
space  robot  system,  however,  adaptive  control  scheme  is  still  demanded. 
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Therefore,  H  -  2C  is  skew-symmetry. 
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Figure  5 


Input  torques  of  robot  ' 


Figure  6  Input  torques  of  robot  joints  using  the  dynamic  control  scheme 

(mo/mi  =  2,  /o//i  =  2) 


Figure  7  Input  torques  of  robot  joints  using  the  PD  regulation  control 

(mo/mi  =  100,  /q/A  =  100) 


Figure  8 


Figure  9 


Input  torques  of  robot  joints  using  the  dynamic  control  scheme 
(mo/mi  =  100,  /o//i  =  100) 


Step  input  response  in  position  X  using  different  control  schemes 


(mo/mi  =  5,  /o//i  =  5) 
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